import numpy as np
import rotations
import time

start_time = time.time()

q1 = np.array([0.1009, 0.82881, 0.20604, 0.51033]).T
q2 = np.array([0.33997, -0.05156, 0.57385, -0.74327]).T

# q1 = np.array([0.34918, 0.35792, -0.09125, 0.86119]).T
# q2 = np.array([0.65186, -0.71915, 0.2397, 0.02098]).T

# q1 = np.array([0.10634, 0.03249, -0.84338, 0.52569]).T
# q2 = np.array([0.21294, 0.35872, -0.70509, -0.57343]).T
#
m = rotations.mori(q1, q2)
m.cubic
a = m.calcMoriAngle
print(a)
print("--- %s seconds ---" % (time.time() - start_time))
